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Descfiptidn 

FIELD OF THE INVENTION: 

5 [0001 ] Tliis invention relates generally to the control of motors and. In particular, to the control of stepper motors such 
as those enptp/ed in robotics and rapid prototyping applications. 

BACKGROUND OF THE INVENTION: 

10 [0002] High performance robotic systems may use dosed loop control such as position, velocity, and acceleration 
sensors, feedback and feed fonward calculations, and signal filtration. The use of feedback enables a level of perfbrm- 
ance near optinrial levels of speed and accuracy for polrit-to-point moves. 

[OOob] As an example, a robotic system that is adapted for a rapid prototyping system (RPS). and that emplcys feed- 
back to control a position of an extrusion nozzle in an x-y-z coordinate reference frame is disclosed in US-A'5.303.141 
IS published on 12.04, 1 994 which does however not form part of the prior art. 

[0004] An example of the generally applied use of feecS>ack in rotjotics. through the use of encoders and possibly 
tachometers, is shown in US-A-4, 749.347. 
; [0005] However, for tow cost robot actuators the additional cost of providing feedback sensors and servo amplifier 
nf>ay be prohibitive. 

20 [0006] Synchronization of multiple axis motion may also be required in robotic applications. Master/slave techniques 
are typically used, such as described in "Multi-axis Controller, by R,C. Russell, US-A-4,41 5,967. 
[0007] The closest prior art EP-A-0440805 disctoses generally a method according to the preamble of claim 1, for 
controlling the feed speed of a tool moving along a machining path in accordance with a machining programm. The 
method derives a correct feed speed, 

25 [0008] Optimization of a point-tOi3oint move time may not, however, optimize the total move time over a trajectory In 
an application of particular interest, the problem that is addressed by this invention can be understood by corrparing 
two sinple trajectories. 

[0009] In a first case. 1000 line segments each 2.54 x lO '^m (0.01 inches) long are concatenated to form a circle with 
a diameter of 8.08 x lO'^m (3.18 inches). Ignoring truncation effects due to the finite step size possible along each axis. 
30 the maximum speed that a robot should make this drcuiar move is dictated by the amount of centripetal acceleratiori 
that the mechanism can accurately sustain. For: a typical case of 0.3 g's of acceleration, the robot should be able to 
negotiate the circle at an average peak speed of 0.345m (13.6 inches) per second, not including the portions required 
for longitudinal acceleration and deceleration. 

[0010] In a second case, 1000 moves of 2.54 x lO '^m (0.01 inches) form a stair case so that there is a 90 degree turn 

35 between each segment If it is assumed that the step size should set the desired accuracy of the system, then the 90 
degree changes of direction must be accomplished in a single motor step. Again for 0.3 g's of acceleration, and assum- 
ing a typical step size of 7.62 x 10 ®m (0.0003 inches); it is found that the velodty at the corners is maximally 3.35 x 10" 
m (0.132 inches) per second. Even assuming that the robot accelerates and decelerates as fast as possible on the 
segments between the corners, the maximum velocity on average is 2.67 x lO'^m (1 ,05 inches) per second, more than 

40 an order of magnitude slower than for the first case. 

[0011] Clearty. it is necessary to k)ok ahead a considerable distance to determine the nature of the trajectory. If there 
aire sharp turns coming, the velocities should be suffidently reduced so that acceleration limits are not exceeded. It is 
also desirable to use the acceleration capabilities of the robol-to the greatest extent possible, which means that tiie 
robot shoiAJ preferably always either be accelerating or decelerating. 

45 [0012] iSeveral known types of high performance robotic controllers measure instantaneous position, velocity, and 
acceleration, and use this information with feed fainward connections based on the coming trajectory to control straight 
line point-tOiXMnt moves. These real time controllers use the fastest available digital agnal processor hardware, but are 
constrained to look, at most, two point-to-point moves ahead. As was indicated in the foregoing example, such a short 
look-ahead approach can require a significant transit time over a trajectory, as conpared to a trajectory that has been 

50 glol>afly maximized. 

SUMMARY OF TH^ INVENTION 

[001 3] It is an object of this invention to accurately predict how the kinanatics of a robot will dictate the detail^ chart 
55 acteristics of a time optimized trajectory, and to then use a simfrfe. time based controller to generate the actuator pulse 
trains required to realize the trajectory, 

[0014] It is a further object of this invention to provide a rhethod for accomplishing trajectory optimization before the 
execution of a robot movement. 
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C0015] Another object Of this iiwention js to p^o^rtde a 

line point-to-point moves, using currently availal)le microprocessor technotogy. to yield a globally optimized trajectory. 
[001 6] A further object of this invention is to provide a method for pre-processing a desired trajectory to optimize motor 
drive sequences so as to traverse the trajectory as rapidly as is possible, and without exceeding the mechanical con- 
traints of the underlying robotics system. 

1001 7] The foregoing and other problems are overcome and the objects of the invention are realized by a method for 
determining a globally optimal trajectory and velocity for a motpr<lriven robot. The inethod utilizes a d^lection angle 
calculation of a maximal velocity for each vertex, a heap sort for globally ensuring that hone of the vertices have an 
excessive velocity, and a vertex adding technique that ensures that the robot is perfwrning straight fine moves as rapidly 
as is possible. 

[00181 More particularly, this invention provides a method for Veducing a time required for an object to be driven by a 
plurality of motors over a predetermined trajectory through an n-dimensional space, wherein n is equal to or greater 
than two. The trajectory is defined by a pluraRty of vertices each having coordinates that define a location within the n- 
dimensional space, TTie method is characterized by the steps of: (a) providing a set of vertices that define a desired 
ti^ectory. each vertex being separated from at least one other vertex by a line segment; (b) for each vertex, determining 
a maximum velocity that can be sustained while translating the bbject through a point in the trajectory that con-esponds 
to the vertex; (c) modifying tfie vertex list, if required, to achieve a velocity proffle over tiie trajectory that causes the 
o^ect to traverse the trajectory in the shortest period of time, without exceeding the maximum velocity at any vertex; 
and (d) translating the modified vertex list Into motor drive signals for causing the plurality of motors to translate the 
object in accordance with the modified vertex list 

[001 9] In an open loop robotics system, tiiat operates m accordance with the method, the motors are stepper motors 
that move a step distance of dj in response to drive signal pulse, where J is the number of degrees of freedom, and 
where 1 ^ j ^ J. Translating ttie object tiirough a point in ttie ti-ajectory from a vertex i-1 to Ho i+1 is shown to result in a 
deflection of angle Oj, An aspect of this invention employs a value of cose, to determine a delay time between drive 
signal pulses for a stepper motor associated with an axis having a fastest movement, also referred to as a master axis, 
[0020] The step of modifying includes the steps of: (a) determining a velocity profile over a run lengtii con^esponding 
to tiie desired tiBjectdry. the velocity profile being determined in accordance with a dynamic characteristic of the stepper 
motor, such as torque; (b) testing an effect of maximum accelerations and maximum decelerations between pairs of 
vertices to determine if a resulting velocity would exceed the determined maximum velocity at one of the vertices of the 
pair; and (c) adjusting the velocities of vertices to enable the use of maxinruim accelerations and decelerations between 
vertices, and inserting, if required, one or more intermediate vertices between the vertices of tfie pair. 

BRIEF DESCRIPTION OF THE DRAWINGS 

[0021] The above set forth and otfier features of the invention are made more apparent in the ensuing Dolled 
Descr^'on of the Invention when read in conjunction with the attached Drawings, wherein: 

Fig. la is a block diagram of a rapid prototyping system that includes a robot that positions a fabrication tool in 
accordance witti this invention; 

Fig. 1 b Is a block diagram of a further embodiment of the invention; 

Rg. 2 graphically d^icts a velocity determination technique enployed by the invention; 

Fig. 3 graphically illustrates an exemplary desired trajectory for a robot, ttie trajectory including a plurafity of verti- 



Fig. 4 is a plot of computed vertex velocities; 

Fig. 5 graphically depicts a stepper motor torque cuwe; 

Fig. 6 graphically depicts a resulting velocity profile for ttie torque curve of Rg. 5; 

Rg. 7 plots velocity indices against run lengtti; 

Rg. 8 lUustrates a revised pfot of velocity indices against run lengtti. after applying a step of ttie flowchart of Rg. 1 0; 
Rg. 9 illustrates a furtfier revised plot of velocity indices against run lengtti. after adding vertices in accordance witti 
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the flowchart of Fig. 10; and 

Figs. 10a and 10b d^ict a ftowchart illustrating a presently preferred method of the invention. 
5 DETAILED DESCRIPTION OF THE INVENTiQN 

[0022] Figure 1 a Is a t)lock diagram that illustrates the use of the invention in a rapid prototypng system 1 0, A xdooX 
is generally indicated by the numeral 1. The robot 1 includes a real time controller 12 having outputs 12a-12d coupled 
to a plurality of stepper motors (SMI -SM4). The stepper motors operate in a conventional fashion so as to provide an 

to incremental rotation (step) of a shaft in response to an input pulse. The stepper motors can also be of the type that pro- 
vide an Incremental linear motion of an actuator element in response to an input pulse. The stepper motors are 
mechanically coupled to a tool 14 that is used in the rapid prototyping process. By example, the tool 14 is an extrusion 
nozzle that is coupled to a pump 15 which provides a source of extrudate. such as a polymer. The end result is the con- 
trolled deposition of Ijeads 16 of extrudate so as to form a three dimensional model of an object of interest The illus- 

75 trated system is a four degree of motion system wherein the tool 1 4 is translated within an x-y-z coordinate reference 
frame by the action of the stepper motors SM1-SM3. plus the extrusion rate of the nozzle controlled by SM4. It should 
l>e realized that one or more of the stepper nrotors can be mechanically coupled to a support structure (not shown) that 
supports the object during the fabrication thereof. In this type of system the tool 14 may be provided with several 
degrees of freedom, as may be underlying siqjport structure. 

20 [0023] The step size along each axis defines the accuracy to which the position along that axis will be determined (± 
of the step size), the deflection angle calculation assumes errors of the order of step size are acceptat)le so that 
finite deflection angles can t)e navigated at reasonable velocities. If, instead of a stepper motor, it is desirat)le to use a 
synchroneous motor and encoder, the following analysis will also apply as long as 2X the positioning error of the closed 
loop system is used instead of the step size of the stepper motor. 

25 [0024] If a microstepping stepper motor driver is used, then subsequent references to a "step" should be interpreted 
as "nrucrostep". 

[0025] It is pointed but that the rolxrt 1 is an open loop system and does not require the use of positional or other 
types of feedback to control the positioning of the tool 1 4. 

[0026] It should also be appredated that the use of an extrusion nozzle for the tool 14 is exemplary only, in that the 
30 tool 14 could comprise, by example, a laser or a means for directing a laser beam so as to cure a photopolymer. as is 

accomplished in stereolitho^aphy prototyping systems. Also by example, the tool 14 could be a device, such as a laser 

or a nozzle for directing a flow of abrasive material, so as to selectively remove material from a block of material. 

In general, the teaching of this invention can be applied with advantage in any robotic system where performance is 

determined by navigating a complex path quickly (at non-uniform velocity). Such applications include flatbed and drum 
35 ptotters. maze following,, glue and caulk applications, film patterning, and solder paste extrusion. The teaching of this 

invention may also be used, although with less benefit, in applications requiring constant feed rates, such as machining 

and painting. 

[0027] That is. the teaching of the invention is applicable to three dimensional prototyping systems that operate by 
additive or sutrtractive methods. Furthermore, the teacNng of this invention is applicable to apf^ications other than rapid 

40 prototyping systems, partteulariy applications wherein it is desired to controllably positfon and/or translate an ol^ect 
[0028] In accordance with the teaching of this iifivention, a processor 1 8 has an output 1 8a coupled to an input of the 
controller 12 and provides a vertex list that is c^mized to most effidently utilize the robot 1, The operation of the proc- 
esso- 18 is described in detail betow. The processor 18 has an input 18b for receiving a vertex list from a source, such 
as an interactive Computer Aided Design (CAD) system. The vertex list that is output by the CAD system may be a 

45 spedf ication of at least an outer shell, and possibly also internal support structures, of a three dimensfonal object to be 
fabricated by the robot 1 . The generation of such vertex lists. t)ased xspon an operator's input, is wen known in the art, 
and will not be further described in detail. In general, the vertex list specifies the desired motfon of the system by a 
sequence of straight line segments from one vertex to the next 

[0029] What is now described fe a presently prefen-ed method for determining the least time motion of the stepper 
50 motor driven rolxrt 1 through a given frajectory. 

[0030] The method assumes that the following conditions exist. 

1 . A set of vertices or points in 2 space. 3 space, or higher dimensionality (additional degrees of freedom) are given 
that d^ine a.desired piecewise linear trsyectory for an object: ^/ = (x ,. y ,.-z p ...) 1 ^/ ^/v., 

55 

2. A spatial position of an object is manipulated l>y stepper motors with known dynamic characteristics, such as 
torque curves and time responses. 
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3. The mechanical characteristics of the robotic manipulator are not time dependent 

(0031 1 A first goal is to cause ttie robot 1 to traverse the desired trajectory as quickly as possWe. A second goal is to 
accomplish this process as inexpensiveiy as possible. This second goal suggests an open loop (no feed bad^ stepper 
s motor system. To maintain the computatiohal requirements to a minimal level, a related goal Is to predetemiine an opti- 
mal control sequence (i.e., which st^er motors to pulse at what times), allowing the inexpensive real-time controller 
12 to execute the predeterrrtned sequence. 

[0032] A presently prefen-ed errtbodiment of the method is shown in the flowchart of Figs, 10a and 10b. 

[0033] The method operates to reduce a time required for an object, such as an extrusion nozzle, to be driven by a 

10 plurality of motors (such as SMI ■SM4) over a predetennined trajectory through an n-dimensiona! space, wherein n is 
equal to or greater than two. The trajectory is d^ned by a fist of vertices each having coordinates that define a location 
within the n-dimensional space, each vertex being separated from at least one other vertex by a fine segment. A vertex 
pair is considered to be two vertices that are nearest neighbors along the trajectory and that are sepamted by a single 
straight line segment. 

15 [0034] The method executes the following steps: 

(A) detennining a maximum velocity that can be maintained for each vertex as the object changes direction when 
being driven from one line segment to the next; 

20 (B) sorting the vertices by ascending maximum velocity; 

(C) examining a pair of vertices consisting of the slowest vertex and a subsequent vertex in the trajectory; 

(Da) if the determined maximum velocity at the subsequent vertex is found to be exactly achieved by accelerating 
2S as fast as po6sft>le from the slowest vertex. 

(Db) maridng the determined maximum velocity at the subsequent vertex as oon^ect; 

(Dc) if the detemiined maximum velocity at the subsequent vertex is found to be greater than the determined max- 
30 imum velocity, 

(Dd) reducing the maximum velodty for tfie subsequent vertex to the value achieved by accelerating as tot as pos- 
sible from the slowest vertex; and . 

35 (De) maridng the reduced maximum velocity at the subsequent vertex as correct. 

[0035] If the detemiined maximum velocity at the subsequent vertex is found to be less than the determined maximum 
velocity, a next step 

<o (Df) mart® the subsequent vertex for a subsequent addition of at least one intennediate vertex. 

[0036] The method then examines a pair of vertices consisting of the slowest vertex and a previous vertex in the tra- 
jectory. 

45 (Ea) H- ttie determined maximum velocity.at the slowest vertex is found to be exactly achieved by decelerating as 
fast as possasle from the prevfous vertex to the slowest vertex, the method executes the steps of. 

(Eb) marking the maximum vetocity at the previous vertex as con^ect; 

50 (Ec) if the determined maximum velocity at the previous vertex is found to be greater than the determined maximum 
velocity. 

(Ed) reducing the maximum vetocity for the previous vertex to the value achieved by decelerating as fast as possible 
from previous vertex to the slowest vertex; and 

55 

(Ee) maridng the reduced maximum velodty of the previous vertex as conect; 

if the detemiined maximum vetocity at the subsequent vertex is foiind to be less than the determined maxi- 
mum velocity. 



5 



(F) 



EP0 642 893B1 

marWngthepfe^ousvertexforasubsequertadditi^ 

A next siep removes the vertex having the lowest maximum velocity from the vertex list; and 



s (G) determines if all vertex pairs have been examined 

«*S ""^^^ the steps (B) through (G); else 
If YES at step Q, the method 



IS 
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maximum allowable vel^. «^ oolti vertices, and where the velocrty at the jryersection is less than a 

»» vaoeily «r« reaches «» rwlnM^SS^Jnll^S,? 
30 in neither an acceleration or adeceleraSon separated by one stepper motor step that results 
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[0047] tf axis i moves a distance dj for each step, and If tfie average acceleration from a standing start for axis 1 Is a/, 
a relationship for the time required to take the first step is given by: 



[0048] While the loads and forces on each axis may be different the step distance d, can be adjusted for each axis 
so that the response time Tj is approximately the same for ail axes: 
10 [0049] Using these assumptions, the velocity associated with each vertex can be determined as shown in Rg 2 
[0050] In moving from vertex i-1 to i to i+1 , the trajectory is deflected by % where 

cose^ 'J ' . 

[0051] It is assumed that the only acceleration at the vert^ is centrpetal; i.a the velocity along the direction of motion 
is constant 



20 



where x is the minimum time per step for any axis, and d is the step distance of the highest velocity axis. For small 
25 deflection* angles, the average centripetal acceleration is 



30 



solving for the time per step yields: 



40 



[0052] Since is the same for all axes, the time delay between pulses is independent of the direction of motion. 
[0053] Since the segments are linear, the cos {d) can be determined as: 



45 [0054] The determined value of cos (Oj) is preferably used to index into a look-up table to obtain the delay time t; 
between pulses for the fastest moving axis, also referred to as the master aws. It should be noted that tiie master axis 
may also be defined to be a virtual axis having an associated movement that is faster than any of the real axes Qearly 
the velocity of vertex i becomes 

50 , 



10055] It is not necessary for the response times of each axis to be the same, or for tfie different axes to be independ- 
ent The determination of the velocity of a given vertex is similar, but more involved in these cases. 
[0056] With reject to the re-setting of vertex velocities, a procedure that guarantees that the robot does not reach 
any vertex with more velocity than a maximum velocity when going around that vertex is best understood with respect 
to Fig. 3, which illustrates an exemplary robot trajectory in x-y. R)ra given segment i. let 
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max, « maximum {\Xfl ly^l. [Z;|. Ip,.|}, define run Ien0hf « 

(similar to the total length traveled). A plot of the computed vertex velocities yvith respect to run length is shown in Fig. 4. 
[0057] A slightly non-standard scale for velocity is used to facilitate later calculations. If the torque curve for a motor 
Is modeled as torque = T^^ - K • RPS . as shovifh in Fig. 5, itis found that the velocity prcfie is 

y(t) = v^(1^-''^P). 

as shown in Fig. 6. 

[0^] In the prefen-ed implementation, using a microprocessor for the controller 12. the velocity of an axis is 

v = d/{n • T^.) 



where d is the step distance, is the time for a single software delay toop, and h is the numl)er of delay loops executed. 
[0059] A velocity ramp is established as an indexed array of delay loop counts {n|}. An acceleration thus involves the 
use of, by example, nj^t delay loops for a next step. Therefore, only a discrete number of velocities vj are available: 

Vj=d/(n|t<,.) 

[0060] The method of denoting velodties by an integer index value and move distances by cunwlative master axis 
steps is useful because an acceleration always appears as a +45** slope line, and similarly a deceleration is a -45^ slope 
line. The object is to provide a velocity index, with respect to run length, of a type shown in Fig. 7, and to therefore con- 
nect ail vertices with ± 45* sloped lines. In tiie case shown in Fig. 7. only vertices 9-10 are so connected. 
[0061] Fig, 8 shows tiie result of applying steps C. D and E as described with r^ect to Figs, 10a and 10b. Vertices 
that are too fast to be achieved with the nominsd: acceleration from either nearest neighbor vertices are thus reset to 
lower velocitiiBS. 

[0062] Having determined vertices with optimal "correct" velocities, and having reset tfie velocities of fast vertices, as 
required, vertex addition is next performed. If a segment is long, compared to the difference between its start vertex 
velocity and end vertex velocity, time is saved by allowing the robot 1 to first accelerate and then decelerate along the 
segment This is equivalent to adding ttie vertices 11-17. as shown in Rg. 9. 

[0063] Because only discrete velocity indices and run lengths are valid, these are cases where the acceleration and 
deceleration ranps meet at a half^nteger. 

[0064] In these cases, such as t>etween vertices 5 and 6. two vertices are added (13 and 14) on ttie nearest integer 
values. 

[0065] There are also cases where the acceleration and deceleratfon ranps would meet at velocities greater tiian tiie 
robot can achieve. This typically will not be the case if the exponential velocity relation (Rg. 6) is used. For this case, 
two vertices are inserted at the maximum velocity (ag. vertices 16 and 1 7). 

[0066] The move_corTpiler subroutine is repeatedly called. Each.time the move_compiler sut)routine is called a new 
requested tool 1 4 position is supplied through global variables (xWequested. y-requested. z^equested). If this is the first 
call of a sequence, vertices 0-2 are initialized. The requested inove is tested for Uniit violations. If necessary, it is broken 
up into a series of smaller moves, so that 16-brt integers can be used. The Pytiiagprean length is computed and mate- 
rial extrusfon pump steps are computed, if required. The maximum posstole velocity of tiie previous vertex is then com- 
puted. The above procedure is repeated for each call to the move-compiler subroutine until the allocated memory is full, 
or until the routine indicates the end of the sequence 

[0067] Next (after routine dump-it) extra moves to enhance material deposition are added. : • 
[0068] Next the vertices are sorted by slowestvelocify by the heap sort algorithm. . 

[0069] Next ttie nearest neighbor vertices, to the slowest vertex, are tested to see if tfiey are too fast or too slow. If 
too fast ttieir velocities are reduced and the heap is reported. The slowest vertex is tiien removed from the heap and 
the procedure repeated till the heaf) is empty. 

[0070] Next one or two vertices are added along those segments that can support an acceleration followed by a 
deceleration. 

[0071] Finally, ttie data is passed to haul Q. which generates the stepper motor pulse sequences in real time. 
[0072] Fig. 1 b illustrates a further embodiment of ttie invention wherein ttie operations of the haulQ routine are in^e- 
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memed in hardware (specifically the block 26). 

100731 In Rg. lb a robotic system 20 includes a vertex list 22 that is output from a trajectory generator (not shown). 
An output 22a of the vertex list provides vertices to a move compiler 24 which inplemehts steps of the method as 
desatoed in detail above. The output 24a of the move compiler 24 is a list conprised of a number of steps for each axis, 
and also the speed of the master axis. Block 26. implements the functions of the haulQ routtfie and interpolates synchro^ 
nized pulse trains for each of the axes. The output of the block 26 is provided to a feedback block 28 having an output 
28a thatisprovided to a stepper motor driver block 30; The steppeir motor driver!*^ 
driving stepper motc^ 1-n. 

[00741 The system 20 further include n encoders, one for each steppja^ motor, having outputs that are provided to an 
encoder data block 32. The block 32 digitizes the encoder outputs and provides tfiis data as in input 28b to the feedback 
block 28. Each encoder output Is representative of a position of the a 

100751 In general, and as is indicated by the switch SW1 . the system 20 operates in an open locp (OL) configuration 
when accelerating one or more of the stepper motors, and operates in a closed Ibop (Cq configuration if it becomes 
necessary to reposition one or more of the stepper nrnitors. Closed loop operation may be necessary if, for exarrple. a 
stepper motor were to stall while accelerating or decelercrti^^^^ 

100761 In operatfon, the feedback block 28 compares the expected pasitibn of each axis with its actual position, as 
indicated by the associated encoder data. If the two positions are different, and if the axfe is not a master axis, and if 
the step rate of the axis is below a preset threshold, then correction steps are output by the feedback block 28 to restore 
the errant axis to the desired position. 

{00771 The inteqpolation btock 26 may be implemented as an Application Specific Integrated Circuit (ASIC) which per- 
forms the functions of the haulQ routine in a rapid manner. The btocks 22 and 24 may be contained within an attached 
processor, such as a workstation, and the link 24a is then a communication link between the workstation and the inter- 
polation block 26 of the actual robot The feedback block 28 may be implemented with a ^^rate processor that per- 
forms the functions of outputting stepper motor drive signals, comparing expected versus actual positions, and 
generating correcting step sequences when required. 

I0tJ781 As was noted previously, the teaching of this invention is not limited to rapid prototyping systems, and is not 
limited for use only with stepper rrxrtors. For Example, the teaching of the irivention can be enptoyed with synchronous 
motors wherein each motor is provided with closed loop control through the use of an encoder or similar feedback sen- 
sor. In this case the minimum resolvable distance. 0,0127 mm for example (one half mil), is eixployed as a "step size", 
and the command stream output by the move conpiler is used an an input to each synchronous motor/encoder combi- 
natioa The use of the invention enables the closed loop gain to be decreased, thereby iriproving stability, while provid- 
ing ihe benefit of preprocessing the required trajectories to enable rapid and gtobally optimal positioning. 

Claims 

1, A method for reducing a time required for an object to be driven by a plurality of motors over a predetermined tra- 
jectory through an n-dimensional space. wher«n n is equal to or greater than two. the trajectory being defined by 
a plurality of vertices each having coordinates that define a location within the n-dlmensfonal space, characterized 
by the steps of: 

providing a set of vertices that define a desired trajectory, each vertex being separated from at least one other 
vertex tiy a line.segment; 

for each vertex, determining a maximum velocity that can be sustained whfle translating the object through a 
, point in the trajectory that corresponds to the vertex; 

modifying the vertex list, if required, to achieve a velocity proffle over the frajectory that causes the ot^ect to 
fraverse the frajectory in the shortest period of time, without exceeding the maximum velocity at any vertex; 
and 

franslating the modified vertex list into motor, drive signals for causing the plurafity of motors to franslate the 
object in accordance with the modified vertex list. 

2, The method as set forth in claim 1. wherein the motors are stepper motors that move a step distance of d in 
response to drive signal pulse, wherein franslating the object through a point in the frajectory from a vertex i-1 to 1 
to 1+1 results in a deflection of angle % and wherein a value of oos6| is employed to determine a delay time 
between drive signal pulses for a stepper, motor associated witii an axis having a fastest movement 
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Tlie method as set forth in claim 2. wherein the step of modifying includes the steps of: 

detemiining a velocity profile over a run length conresponding to the desired trajectory, the velocity profile being 
detemiined in accordance with a dynamic characteristic of the stepper HTK^ 

testing an effect of maximum accelerations and maximum decelerations between pairs of vertices to determine 
if a resulting velocity would exceed the detennined maximum velocity at one of the vertices of the pair; and 

adjusting the velocities of vertices to enable the use of maximum accelerations and decelerations between ver- 
tices, and inserting, if required, one or more intemiecBate vertices between the vertices of the pair. 

The method as set forth In daim 3 wherein the dynamic characteristic is torque. 

The method of claim 1 . oonpising the steps of : 

(a) detemiinffig a maximum velocity that can be maintained for each vertex as the object changes direction 
when being driven from one fine segment to the next; 

(b) sorting the vertices by ascending maximum velocity; 

(c) examining a pair of vertices consisting of the slowest vertex and a subsequent vertex in the trajectory; 

if the determined maximum velocity at the subsequent vertex is found to be exactly achieved by accelerating 
as fast as possible from the slowest vertex, m 

(d) marking determined maximum velocity at the subsequM vertex as con-ect; 

if the determined maximum velocity at the subsequent vertex is found to be greater than the determined max- 
imum velodty. 

(e) reducing the maximum velocity for the subsequent vertex to the value achieved by accelerating as feist as 
possible from the slowest vertex; and 

(f) marking the reduced niaximum velocity at the subsequent vertex as coH'ect; 

if the determined maximum velocity at the subsequent vertex is found to be less than the determined maximum 
velocity, 

(g) marking the sul)sequent vertex for a subsequent addition of at least one intermediate vertex; 

(h) examining a pair of vertices consisting of the slowest vertex and a previous vertex in the trajectory; 

if the determined maximum velocity at the slowest vertex Is found to be exactly achieved by decelerating as fast 
as possible from the previous vertex to the slowest vertex, 

(i) marking the maximum velocity at the previous vertex as correct; 

if the determined maxinwm velocity at the previous vertex is found to be greater tiian the determined maximum 
velocity, 

Q) reducing the maximum velocity for the f^evious vertex to the value achieved by decelerating as fast as pos- 
sWe from prevfous vertex to the stowest vertex; and 

(k) niarking the reduced maximum velocity of the previous vertex as con-ect; 

if the determined maximum velocity at the subsequent vertex is found to be less than the detemiined maximum 
velocity, 

(I) marking the previous vertex for a sit)sequent addition of at least one intermediate vertex; 
(m) renxnring the vertex having the lowest maximum velocity from the vertex fist; 
(n) determining if all vertex pairs have been examined; 
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(0) if NO. repeating the steps (b) through (n): else 

(p) if YES. adding at least one intermediate vertex tjetween each vertex pair previously marked.for vertex 
tion:and 

(q) determining from the resulting vertex list a sequence of motor control signals so as to cause the object to 
be driven over the trajectory so as to achieve the indicated velocities at ^ch vertex of the resulting vertex list 

6. The method as set forth in daim 5. wherein the motors are stepper motors, and wherein the step (q) adds a single 
vertex iff a lull acceleration from the first of the pair of vertices, and a full deceleration to the second of the pair of 
vertices, results in a position, along the line segment connecting the pair of vertices, where the accelerating and 
dec^erating velocities are the same, and which is an integer number of stepper motor steps from both vertices, and 
where the velocity at the intersection is less than a maximum allowable velocity. 

7. The method as set forth in claim 5, wherein If a full acceleration, followed by full deceleration, along the line seg- 
ment between the pair of vertices will cause the velocity to reach a maxinnim allowable velocity, the step (q) adds 
a first vertex at a p«nt on the line segment where the velocity first reaches the maximum allowable value, and a 
second vertex at a point on the line segment wfiereat a full acceleration will r^ult in the second vertex being 
reached at the determined maximum velocity. 

8. The method as set forth in daim 7. v^emtx the motors are stepper motors, and wherein if a full acceleration ranp 
and a full deceleration ramp intersect at a non-integer number of st^er motor steps, the step (q) adds two verti- 
ces along the line segment that are separated by one stepper motor step that resultslfj neither an acceleration or 
a deceleration. 

9. The method as set forth in daim 5, wherein the step (b) is acconpGshed with a heap sort 

10. The method as set forth in daim 5. wherein the motors are st^er motors, wherein translating the object through 
a point in the trajectory from a vertex i-1 to i to i+1 results in a deflection of angle % and wherein ^ep (a) employs 
a value of cose , to detern^ne the maximum velocity for the vertex i. 

PatentansprOche 

1 . Verfahren zum Reduzieren einer Zeit, die ertbrderlich ist. urn ein Objekl durch mehrere Motoren auf einer vorbe- 
stimmten Bahn in einem n-dmensionalen Raum anzutretoen. wobei n gleich Oder grOBer als zwei ist und wobei die 
Bahn durch eine Vielzahl von Scheitelpunkten definiert ist. die jeweils Kbordinaten haben. weiche einen Ort inner- 
hatt) des n-dimensionalen Raums definieren. gekennzeichnel durch die Schritte: 

Bereitstellen einer Schar: von Scheitelpunkten. die eine gewOnschte Bahn deftiieren, wobei jeder Scheitel- 
punkt yon wenigstens einem anderen Scheitelpunkt durch einen Streckenabschnitt getrennt ist; 

fur jeden Scheitelpunkt, Bestimmen einer maximalen Geschwindigkeit. die ausgefOhrt warden kann, wahrend 
sich das Objekt durch einen Punkt auf der Bahn bewegt welcher dem Scheitelpunkt entspricht; 

Modiffizieren der Scheite^punktfiste. bei Bedarf. um ein Geschwindigkertsproffl uber der Bahn zu erzielen. wel- 
ches bewirkt. daB das Objekt die Bahn in der kOrzesten Zeitspanne zurOcWegt. ohne die maximale Geschwin- 
digkeit in irgendeinem Scheitelpunkt^u Qberschreiten: und 

Umsetzen der modifizierten Scheitefpunkfliste in Motoransteuersignale. weiche bewirten. da6 die Motoren 
das Ot)jekt gemdS der modifizierten Scheitelpunktliste verschieben. 

2. Verfahren nach Anspruch 1. wobei die Motoren Schrittmotoren sind. cfie sich um eine Schritteiistanz d au^nmd 
eines Ansteuersignalimpulses bewegen.vWobei das Verschieben des Ot)jekts durch einen Punkt auf 6& Bahn von 
einem Scheitelpunkt i-1 bis i bis i+1 in einer AWenkung um einen Winkel Oi resultiert und wobei ein Wert von cos 
benutzt wind, um eine.VerzOgerungszeit zwischen Ansteuersigr«limpulsen for einen Schrittmotor zu bestimmen' 
der einer Achse zugeordnet ist. die eine schnellste Bewegung hat 

3. Vertahren nach Anspmch 2. wobei der Schritt des Modifizierens die Schritte beinhaltet 
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Bestimmen eines GeschwincBgkeitsprofils Ctoer einer Laufiange' die der gewOnschten Bahn entspricht wobei 
das Geschwindigkeitsprofii gemaB aner dynamischen Eigenschaff des Schrittnx>tors bestimmt wird; 

Testen einer Auswirkung von maximalen Beschleunigungen und maximalen Veriangsamungen zwischen Paa- 
5 ten von Scheitelpunkten, um festzustellen ob eirie resultierende Geschwindigkeit die vorbestimmte Maxinfial- 

geschwindigkeit in einem der Scheitelpunkte des Paares ubersteigen wOrde; und 

Einstellen der Geschwindigkeiten von Scheite^unkten. um die Benutzung yon maximalen Beschleunigungen 
und Veriangsamungen zwischen Scheitelpunklen zu ermOglichen, und BnfOgen, bei Bedarf. von einem oder 
10 mehreren Zwischenscheite^unkten zwischen den Scheitelpunkteh des Paares. 

4. Verfahrennach Anspruch3,yrob^ diedynarrts^ 

5. Verfahrennach Anspruch l.benihaltenddie Schritte: 

IS 

(a) Ermittein einer maximalen Geschwindigkeit, die fur jeden Sch«telpunkt aufrechterhalten werden kann. 
wenn das Ot^ekt die Richtung Andert. wi^nn es yon einem Streickenabschnitt zum ndchsten angetrieben wird: 

(b) Sortieren der Scheitelpunkte nach aulsteigender maximaler Geschwindigkeit; 

20 

(c) PrOfen von einem Paar Scheitelpunkten, das aus dem langsamsten Scheitelpunkt und einem anschlieOen- 
den Scheitelpunkt auf der Bahn besteht;. 

wenn es sich zeigt daB die ennittelte maximale Geschwindigkeit in dem anschlieBen^en Scheitelpunkt exakt 
enreicht wind, indem so schnell wie mOglich von dem langsamsten Scheitelpunkt aus beschleunigt wird, 

25 

(d) Markieren der ermittelten maximalen Geschwindigkeit in dem anschlieBenden Scheitelpunkt als koaekl; 
wenn es sich zeigt, daB die ermittelte maximale Geschwindigkeit in dem anschlieBenden Scheiteljxinkt grOBer 
als die emiittelte maximale Geschwindigkeit ist, 

30 (e) Reduzieren der maximalen Geschwindigkeit fOr den anschlieBenden Scheitelpunkt auf den Wert, der 

erzielt wird. indem von dem langsamsten Scheitelpunkt aus so schnell wie mOglich beschleunigt wird; 

(f) Markieren der reduzierten maximalen Geschwindigkeit in dem anschlieBenden Scheitelpunkt als konekt; 
wenn es sich zeigt. daB die ermittelte maximale Geschwindigkeit in dem anschlieBenden Scheitelpunkt nied- 

35 riger als die ermittelte maximale Geschwindigkeit ist.. 

(g) Markieren des anschlieBenden Scheltefpunktes fOr.eine anschlieBende Addition vpn wenigslens einem 
Zwischenscheiteipunkt; 

40 (h) Prufen von einem Paar Scheitelpunkten' das aus dem langsamsten Scheite^nkt und einem vorhergehen- 

den Schatelpunkt auf der Bahn besteht; 

wenn es sich zeigt daB die ermittelte maximale Geschwiitligkeit in dem langsamst^ Scheltefpunkt exakt 
enreicht wind, indem so schnell wie mOgjich ab dem vorhergehenden Scheitelpurikt bis zu dem langsamsten 
Scheitelpunkt verlangsamt wind, 

45 

(i) Markieren der maximalen Geschwindigkeit in dem vorhergehenden Scheitelpunkt als korrekt; 

wenn es 8k:h zeigt. daB die ermittelte maximale Geschwindigkeit in dem vorhergehenden ScheitelpunkI grOBer 

als die ermittelte maximale Geschwindigkeit ist, . ... 

50 (j) Reduzieren der maximalen Geschwindigkeit fur den vorhergehenden Scheitelpunkt auf den Wert, der 

enreicht wind, indem so schnell wie mOglich ab dem vorhergehenden Scheitelpunkt bis zu dem langsamsten 
Schatelpunkt verlangsamt wird; und 

(k) Markieren der reduzierten maximalen Geschwindigkeit des vorhergehenden Scheitelpunktes ais korrekt; 
55 wenn es sich zeigt. daB die ermittelte maximale Geschwindigkeit In dem anschlieBenden Scheitelpunkt Meiner 

als die ermittelte maximale Geschwirxjigkeit ist 

(1) Markieren des vorhergehenden Scheitelpunl^es fur eine anscNieBende Addition von wenigstens einem 
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Zwischenscheitelpunkt; 

(m) Entfemen des Scheitefpunktes' der die nt edrigste maxiniale Geschwindigkeit hat. aus der Scheitelpunktli- 
ste; 

(n) Feststellen. ob alle Scheitelpunklpaare gepruft worden sind: 
(o) wenn NEIN. Wiedeitiolender Schrme (b) bis^^^^^ 

(p) wenn JA. Addieren von wenigstens einem Zwischenscheitelpunkt zwischen jedem Scheitelpunktpaar, das 
zuvor for die Scheitelpuhktaddition marWert worden ist; und 

(q) Ernnitteln einer Sequenz von Motorsteuersignalen aus der resultierenden Scheitelpunktliste. urn so zu 
bewirken. daB das CX)jekt so auf der Bahn angetri^en wird. daB die angezeigten Geschwindigteiten in jedem 
Scheitefpunkt der resultierenden Scheiteipunktiste erzielt werden. 

6. Verlahren nach Anspruch 5, wobei die Motoren Schrittmotoren sind und wobei der Schritt (q) euien einzelnen 
Scheitelpunkt addiert wenn eine voile Beischleunigung ab dem ersten Scheitelpunkt des Paares von Scheitelpunk- 
ten und eine voile Verlangsamung bis zu dem zweiten Scheitelpunkt des Paares von Scheitelpunkten in einer Posi- 
tion langs des Streckenabschnttls resuttiert welcher das Paar von Scheitelpunkten verblndet wo die 
Beschleuni^ngs- und Verlangsamungsgeschwindigkeiten dieselben sind, und welches eine ganze Zahl von 
Schrittmotorschritten von beiden Scheitelpunkten aus ist, und wo die Geschwindigkeit in dem Schnittpunkt Weiner 
ist ats eine maximal zuldssige Geschwindigkeit. ^ 

7. Verfahren nach Anspruch 5, wobei. wenn eine voile Beschleunigung. gefblgt von einer vollen Verlangsamung. 
langs des Streckenabschnitts zvi^schen dem Paar Scheitelpunkten bewirken wild. daB die Geschwindigkeit eine 
maximal zuldssige Geschwindigkeit en^eicht. der Schritt (q) einen ersten Scheitelpunkt in einem Punkt auf dem 
Streckenabschnitt addiert, wo die Geschwindigkeit zum-ersten Mai den maximal zuldssigen Wert erreicht. und 
einen zweiten Scheitelpunkt in einem Punkt auf dem Streckenabschnitt, ab welchem eine voile Beschleunigung 
dazu fOhren wird. daB der zweite Scheitelpunkt rrat der enmittelten maximalen Geschwindigkeit erreicht wird. 

8. Verfahren nach Anspruch 7, wobei die Motoren Schrittmotoren sind. und wobei. wenn eine volte Beschleunigungs- 
rampe und eine voile Veriangsamungsrampe ^ich in einer unganzzahligen ZaW von Schrittmotorschritten schnei- 
den, der Schritt (q) zwo Scheitelpunkte larigs des Streckenabschnitts addiert. die durch einen Schrittmotorschritt 
getrennt sind. der weder zu einer Beschleunigung lioch zu einer Verlangsanung fOhrt 

9. Verfahren nach Anspmch 5, wobei der Schritt (b) mit einer Gnjppensorttemng ausgefOhrt wird: 

1 0. Verfahren nach Anspruch 5. wobei die Motoren Schrittmotoren sind. wobei das Bewegen des Objekts durch einen 
Punkt auf der Bahn von einem Scheitelpunkt i-1 bis i b« i+1 zu einer AWenkung um einen Winkel Oj fQhrt und Wobei 
der Schritt (a) einen Wert von cos Oi verwendet. um die maximale Geschwindigkeit fOr den Scheitelpunkt i zu 
ermitteln. . 

Revendications 

1 . Proc6d6 pour r6duire le tenrps exig6 pour qu'un objet soit entraTn6 par une pluralit6 de moteurs sur une trajectoire 
pr^^ermin6e d travers un espace k n dimensk)ns, n.^tant 6gal ou sup4rieur k deux, la trajectoire 6tant d6f inie par 
une plurality de sommets ayant chacun des coordonn6es qui d^inissent un emplacement dans Tespace k n 
dimensions. caract6ris6 en ce quH comprend les stapes conslstant d Ibumir un ensen^e de sommets qui d^finis- 
sent une trajectoire d6sir6e, chaque sommet 6tant s6par6 tfau moins un autre sommet par un segment de ligne. 
k d^erminer. pour chaque sommet. une Vitesse rnaximale qui peut etre maintenue tors du passage de Pobjet par 
un point sur la trajectoire qui correspond au sommet k modifier, si n6cessaire. la liste des sommets pour obtenir 
un profit de vitesse. sur ta trajectoire. c^i am^ne t'objet ^ parcouriir la tr^ectoire dans la plus courte p6rkx1e de 
temps, sans dosser la vitesse maximale k un sommet quelconque. et k convertir la liste des sommets modifi6e 
en signaux d'attaque des moteurs pour amener la plurality de moteurs k d^placer t'objet en accord avec la liste des 
sommets modifi^e. 

2. Proc6d6 suivant la revendication 1 caract6ris6 en ce que les moteurs sont des motairs pas k pas qui se d^placent 
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(f une distance de pas d en r6ponse d une impulsion de signal d*attaque. le passage de I'objet par un point sur la 
treyectoire. dun sommet il k un sonnmet i puis ^ un sommet se tradutt par une d^ation d*un angle % et une 
valeur de cos est enploy^e pour determiner un temps de retard entre des impulsions de signal d*attaque pour 
. unmoteur pas d pas associ6 dun axe ayantlemouvementle plus rapide. 

3. Proc6d6 suivant la revendication 2 caract6ris6 en ce que r6tape de modification conporte les 6tapes consislant k 
determiner un profit de yitesse sur une longueur.de course correspondant h la trajectoire d^sir^e. te profil de 
Vitesse 6tant determine en accord ayec une caract4ristique dynamique du moteur pas d pas. d tester un effet 
d'aoc6l^ions maxinr»les et de d^I6rations maxfmales entre des paires de sonnets afin de ddtemiiner si une 
Vitesse r§sultante d6passerait la vitesse maximale d6ternwi6e rendroit d I'un des sommets de la paire. et d 
ajuster les vitesses des sommets de mani^e d permettre l^utilisatipn d acc^^tion^ et d^i^l^rations maximales 
entre les sommets et a insurer, si n6cessaire. un ou plusteurs sornmets interm^iaires entire les sommets de la 
paire 

4. Proc6d6 suivant la revendication 3 caract^ris^ en ce que la caract^i^ue dynamique est le couple. . 

5. Proc^6 suivant la revendication 1 caract6ris6 en ce quH comprend les, 6tapes conststant : 

(a) & determiner une vitesse maximale qui peut dtre maintenue pour chaque sonmet tandis que Tobjet change 
de direction lorsqull est entrain^ d'un segment de ftgne au segment suivant; 

(b) h trier les sommets dans Tordre de leur vitesse maximale croissante; 

(c) d examiner une paire de sommets oonstituee par le sommet le plus lent et un sommet subsequent dans la 
treyectoire; 

si la Vitesse maximale d6terminee d Tendroit du sommet subsequent est trouvee etre atteinte exactement en 
accelerant aussi rapidement que poss(t)le d partir du sommet le plus lent, 

(d) k marquer la vitesse maxinfiale determinee A Tendroit du sommet subsequent comme etant correcte; 

si la Vitesse maximale determinee k rendroit du sommet subsequent esX trouvee etre superieure h la vitesse 
maximale determinee. 

(e) k reduire la vitesse maximale pour le sommet subsequent k la valeur atteinte par une acceleration aussi 
raplde que possible k partir du sommet le plus lent ; et 

(f) k marquer la vitesse maximale reduite k I'endrott du sommet subsequent comme etant correcte; 

si la Vitesse maximale determinee k Tenc^oit du sommet sid)sequent est trouvee etre interieure k la vitesse 
maximale determinee. 

(g) d marquer le sommet subsequent en yue d'une addition subsequente d'au moihs un sommet intermediaire; 

(h) d examiner une paire de sommets cpnstituee par le sommet le plus lent et un sommet precedent dans la 

trajectoire; 

si la Vitesse maximale determineeii rendroit du sommet le plus lent est trouvee etre atteinte exactement pjar 
une deceleration aussi rapide que possible e partir du sommet precedent jusqu'au ^mmet le plus lent 

(i) k marquer la yitesse maximale k I'endroit du sommet precedent comme etant con-ecte; 

si la Vitesse maximale determinee k rendroit du sommet precedent est trouvee dtre superieure k la vitesse 
maximale determinee. 

0) k reduire la vitesse maximale pour le sommet precedent k la valeur atteinte par une deceleration aussi 

rapide que possible k partir du sommet precedent jusqu*au sommet le plus lent; et 

(k) k marquer la vitesse maximale reduite du sbmnriet precederit conime etant correcte; ^ 

si la Vitesse maximale detemiinee k rendroit du sarmeA sii)sequent est trouvee etre inferieure k la vitesse 

maximale determinee, 

(I) k marquer le sonvnet precedent en vue tfune addition sut)sequente d*au moins un sommet intermediaire; 
(m) k stppnmer le sommet ayant la vitesse maximale la plus basse de la liste des sommets; 
(n) k determiner si toutes les paires de sommets ont ete examinees; 
(o) si la reponse est NON. k repeter les etapes (b) k (n); 

(p) si la reponse est OOlk ajouter au mdns un sommet intermediaire entre chaque paire de sommets prece- 
demment marques en vue d'une addition d'un sommet; et 

(q) k determiner, k partir de la liste des sommets resultants, une sequence de signaux de commando des 
moteurs de maniere k amener I'objet k etre entraTne suivant la trajectoire afm d*atteindre les vitesses indtquees 
k rendroit de chaque sonvnet de la liste des sommets resultante. 

6. Precede suivant la revendication S caractens6 en ce que les moteurs sont des nwteurs pas k pas et retape (g) 
ajoute un seul sommet si une acceleration totale k partir du prenrver sommet de la paire de sonmets et une dece- 
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juration totale vers le second sommet de ia paire de sommets se tradu'rt par tine position, le long du segment de 
ligne oonnectant la palre de sommets. ou les vitesses d'acc^l^tion et d(§c^I6ration sont les m^mes, et qui est un 
nonrt>r6 entler de pas des moteurs pas i pas d partir des d^ sommets, ^ du la Vitesse h Tintersectlon est inf6- 
rieure & une Vitesse maximale adn^sit)le. 

s 

7. .Proc|6d6 suivant la revendication 5 caract^ris^ en ce que si une acc^^ratton totale, suivie par une d6c6l6ration 
totale, le lorig du segment de ligne entre> paire de sommets am^ne la Vitesse d atteindre une Vitesse maximale 
adnvssHie. r6tape (iq) ajoiite uh premier sommet k rendroct dlih pdint. sur le segment de ligne. oCi la vitesse attaint 
en premier la >^ess6 maximale admissible, et un second somrriiBt eh im point, sur le segment de ligne. ou une 

10 acc4l^atipn totale se traduit par ie fait que le second sommet est attetnt $ la vit^e maximale ddtenninde. 

8. Proc6d6 suivant la revencfication 7 caract6ris6 eh ce que les moteurs sont des moteurs pas k pas et si une rampe 
tfacc^li^ration totale et une rampe de d^^6rati6n totale se recoupent d Pendroit d'un nombre non entier de pas 
des moteurs pas k pas, r^tape (q) ajoute. je long du segpnent de ligne, deux sonmets qui sont s6par6s par un pas 

IS des moteurs pas k pas, ce qui se traduit par ni une acceleration ni une deceieratioa 

9. Precede suivant la revendication 5 caracterise en ce que retape (b) est accqnr^Iie avec un tri en tas. 

10. Precede suivant la revendication 5 caracterise en ce que les moteurs sont des moteurs pas k pas. le passage de 
20 rot>iet par un point sur la trajectoire, d'un sonnet i-1 k un sommet i puis k un sonfunet i+1 se traduit par une devia- 
tion d'un angle % et une valeur de cos 6 , est employee dans retape (a) pour determiner la vitesse maximale pour 
le sommet i. 
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CLAIMS 

1. A visually controlled robot system comprising: 
a robot control device for controlling an 
operation of a robot body: 

a vision sensor system for detecting visual 

information; and 

a common operator panel having means for selecting 
one of a first mode for carrying out an operation 
related to said robot control device and a second mode 
for carrying out an operation related to said vision 
sensor system.' to carry out said operations. 

2, A visually controlled robot system according 
to claim 1. wherein said vision sensor system includes 
a vision sensor for imaging at least a subject of work. 

15 and a vision sensor controller for analyzing a picture 
signal from said vision sensor, said vision sensor 
controller being connected to said operator panel. 

3. A visually controlled robot system according 
to claim 1. wherein an operation common to said first 
and second modes Is executed through an identical 
operation of the operator panel by an operator. 

4 A visually controlled robot system according 
to any one of claims 1 to 4. wherein a welding torch is 
mounted to said robot body to carry out arc welding. 
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